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Abstract 

Autonomous  and  teleoperated  mobile  robots  require  an  accurate  knowledge  of  their  spatial  location 
in  order  to  accomplish  many  tasks.  Many  mobile  robots  make  use  of  dead  reckoning  navigation 
because  of  its  simplicity,  low  cost  and  robustness.  Although  dead  reckoning  navigation  has  been 
used  for  centuries  for  ships  and  wheeled  vehicles,  the  application  to  a  walking  machine  is  novel. 
Since  walking  machines  differ  greatly  from  ships  and  wheeled  vehicles,  a  new  approach  to  dead 
reckoning  was  developed  to  solve  this  problem.  This  paper  discusses  the  problem,  a  solution,  pre¬ 
liminary  test  results  and  future  goals  for  dead  reckoning  navigation.  Experiments  were  done  with 
the  CMU  Ambler,  an  autonomous,  six-legged  walking  robot,  but  the  results  are  general  and  apply 
to  any  statically  stable  walking  robot.  The  current  results  show  a  systematic  bias  of  two  percent  of 
body  advance  in  the  direction  of  travel.  Although  the  cause  of  this  bias  is  unknown,  it  is  corrected 
in  the  position  estimation  routines. 


1  Introduction 


Autonomous  and  teleoperated  mobile  robots  require  an  accurate  knowledge  of  their  spatial  location 
in  order  to  accomplish  many  tasks.  Many  mobde  robots  make  use  of  dead  reckoning  navigation 
because  of  its  simplicity,  low  cost  and  robi:.yiness.  Although  dead  reckoning  navigation  has  been 
used  for  centuries  for  ships  and  whee’cd  vehicles,  the  application  to  a  walking  machine  is  novel. 
Since  walking  machines  differ  greatly  from  ships  and  wheeled  vehicles,  a  new  approach  to  dead 
reckoning  was  developed  to  solve  this  problem.  This  paper  discusses  the  problem,  a  solution,  pre¬ 
liminary  test  results  and  future  goals  for  dead  reckoning  navigation.  Experiments  were  done  with 
the  CMU  Ambler,  an  autonomous,  six-legged  walking  robot,  but  the  results  are  general  and  apply 
to  any  statically  stable  walking  robot. 

Dead  reckoning  is  defined  as: 

The  detemhnation,  without  the  aid  of  external  observations,  of  the  po.sition 
and  orientation  of  a  vehicle  from  the  record  of  the  courses  travelled,  the 
distance  made,  and  the  known  estimated  drift.  ’ 

A  vehicle,  starting  from  an  initial  position,  P^,  travels  along  a  path  segment  defined  by 
and  dj,  see  Figure  1.1.  The  new  position,  P can  be  estimated  from  the  course  and  distance  trav¬ 
elled.  The  accuracy  of  the  location  is  dependent  on  the  accuracy  of  the  data,  since  there  is  no  way 
to  verify  the  new  location.  Therefore,  the  proper  representation  of  the  new  location  is  a  position 
with  an  associated  uncertainty,  which  is  represented  as  a  circle  in  Figure  1.1.  Furthermore,  at  each 
subsequent  location,  the  positional  uncertainty  increases. 

The  implementation  of  dead  reckoning  for  a  vehicle  such  as  a  car  (travelling  over  smooth 
terrain),  boat  or  plane  is  straight  forwtu-d.  The  instrumentation  required  is  a  speedometer,  a  com¬ 
pass  and  a  clock  (or  alternatively  an  odometer  and  a  compass).  The  drift  can  be  estimated  by  the 
known  precision  and  accuracy  of  the  devices  and  an  estimation  of  non-measurable  displacement, 
such  as  ocean  currents.  For  a  car,  assuming  the  initial  heading  is  known,  the  compass  can  be  elim¬ 
inated  by  keeping  track  of  the  change  in  heading  of  the  vehicle.  This  technique  has  been  used  by 


1 .  Motlilicd  trorn  Wchsicr  s  Dictionary,  \yhich  restricts  the  definition  to  the  position  of  ships  and  planes. 


mariners  for  centuries  when  stellar  navigation  was  rendered  impossible  by  weather  conditions.  The 
technique  is  used  in  modern  times  by  competitors  in  automobile  road-rallies  and  the  sport  of  ori¬ 
enteering. 

An  important  limitation  of  dead  reckoning  navigation,  is  that  it  can  not  account  for  changes 
in  the  vehicle’s  position  which  do  not  affect  its  measuring  devices.  For  instance,  if  a  vehicle  were 
picked  up  from  one  location  and  placed  down  in  another,  dead  reckoning  would  not  report  a  change 
in  position.  This  limitation  does  not  hold  for  systems  which  require  external  observations,  since 
any  change  in  position  is  readily  apparent. 

Although  prone  to  error  and  generally  not  as  accurate  as  other  methods  of  navigation,  dead 
reckoning  can  be  more  robust  than  other  navigators  since  it  will  continue  to  function  when  others 
fail.  Furthermore,  dead  reckoning  navigation  is  less  expensive,  typically  by  several  orders  of  mag¬ 
nitude,  than  other  navigational  devices.  Although  in  certain  special  instances  dead  reckoning  nav¬ 
igation  alone  may  provide  sufficient  navigational  accuracy,  in  general,  it  should  be  combined  with 
other  navigational  techniques  to  provide  greater  accuracy.  See  Section  6  for  further  details. 

For  the  reasons  elucidated  above,  dead  reckoning  navigation  was  implemented  on  the  CMU 
Ambler,  an  autonomous,  six-legged  walking  robot  for  planetary  exploration.  Section  Figure  1.2  is 
a  diagram  of  the  .Ambler.  References  lBW89|,IBW9()],lMan9()|,[Bar91]  provide  a  description  of 
the  machine,  its  capabilities  and  dynamics. 

Since  wheeled  vehicles  maintain  continuous  contact  with  the  ground,  the  distance  the  ve¬ 
hicle  travels  can  be  calculated  from  the  number  of  wheel  revolutions.  (This  assumes  benign  terrain. 
In  rough  terrain,  the  body  displacement  can  be  estimated  by  averaging  the  rotations  of  all  wheels, 
however  this  is  typically  not  very  accurate.)  Flowever,  when  the  Ambler  body  moves,  the  feet  re¬ 
main  stationary  (see  discussion  in  Section  6),  therefore,  there  is  no  direct  means  of  measuring  the 
Ambler’s  displacement.  This  necessitates  a  new  methodology  for  dead  reckoning  estimation.  Fur¬ 
thermore.  the  authors  claim  that  this  new  methodology  works  equally  well  on  benign  terrain  as  on 
severe  terrain,  an'i  that  the  dead  reckoning  for  this  class  of  walking  machines  will  be  more  accurate 
than  wheeled  machines  over  severe  terrain. 


Figure  1.2.  The  CML’  Anil)ler 
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This  report  is  organized  as  follows;  Section  2  describes  dead  reckoning  navigation  that  has 
been  previously  implemented  for  other  robotic  systems.  Section  3  presents  a  formal  statement  of 
the  problem.  Section  4  describes  the  approach  implemented.  Section  5  presents  the  results  from  the 
original  tests  of  the  system,  improvements  that  were  made  ba.sed  on  the.se  results,  and  a  second  set 
of  test  results.  The  final  chapters  discuss  future  work,  improvements  and  conclusions.  Appendix  A 
discus.ses  some  of  the  early  approaches  considered  and  why  they  were  di.scarded. 

2  Previous  Work 

Since  few  mobile  robots  exist,  there  are  few  published  articles  pertaining  to  the  use  of  dead  reck¬ 
oning  navigation  for  this  type  of  system.  The  papers  by  Smith  et  al.  [SSC86]  and  |  SC86],  deal  with 
a  robot  on  a  planar  surface  and  discuss  the  effect  of  the  cumulation  of  error.  This  work  is  concep¬ 
tually  important,  but  the  authors  do  not  appear  to  have  tested  this  theory  on  a  real  robot.  Further¬ 
more,  these  papers  assume  some  external  sensing  devices,  such  as  acoustic  sensors  or  cameras. 
Similarly,  the  papers  by  Watanabe  et  ai,  1WS9()|,  and  Crowley,  |Cro89],  assume  external  sensors 
as  well  as  dead  reckoned  position  infomiation. 

The  paper  by  Amidi,  [  Ami9()l,  provides  a  di.scussion  of  an  implementation  of  dead  reckon¬ 
ing  navigation  for  wheeled  vehicles,  and  its  actual  implementation  on  the  CMU  NavLab.  The  paper 
pre.sents  equations  for  detennining  the  dead  reckoned  position  of  a  wheeled  robot  on  benign  ter¬ 
rain.  The  accuracy  of  the  model  was  determined  by  comparing  dead  reckoned  position  estimates 
with  positioning  information  obtained  from  a  Global  Positioning  Satellite  (GPS)  system.  In  addi¬ 
tion,  there  is  a  discussion  of  sensor  fusion  for  improving  overall  s\  stem  navigation.  . 

The  author  is  not  aware  of  any  work  discussing  dead  reckoning  navigation  for  legged  ve¬ 
hicles.  This  may  be  due  in  part  to  the  very  small  number  of  legged  vehicles  in  existence  today. 

3  Problem  Statement 

The  problem  is  to  determine  the  position  and  orientation  of  a  walking  robot  at  any  given  time.  To 
do  this  a  coordinate  system,  called  the  body  frame,  will  be  assigned  to  the  robot.  Another  coordi¬ 
nate  system,  called  the  world  frame,  will  be  assigned  to  a  frame  of  reference.  Points  in  one  frame 
are  mapped  into  the  other  frame  by  a  translation  (by  a  vector  T)  and  a  rotation  (by  a  matrix  R). 
Figure  3. 1  below  shows  the  world  frame,  the  body  frame  and  a  point,),  fixed  in  the  body  frame. 
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If  the  position  of  a  point  fixed  on  a  rigid  body  and  orientation  of  that  body  were  known  for 
all  time  in  some  frame,  then  the  position  of  any  other  point  on  that  body,  with  respect  to  the  spec¬ 
ified  frame,  is  readily  calculated  for  all  time.  But  this  will  not  work  for  the  Ambler  for  several  rea¬ 
sons:  First,  the  Ambler  has  automatic  body  leveling,  which  permits  continual  reflexive  changes  in 
body  orientation.  Second,  structural  deformation  will  also  lead  to  unmodelable  changes  in  orienta¬ 
tion.  Third,  the  technique  u.sed  to  set  a  foot  on  the  ground  causes  unintentional  changes  in  body 
orientation.  Fourth,  small  soil  deformations  can  also  cause  unreported  changes  in  body  orientation 
as  well  as  in  foot  position.  (See  the  discussion  in  Section  6.)  These  reasons  preclude  the  possibility 
of  storing  body  orientation  and  using  a  simple  scheme  based  solely  on  the  addition  of  displace¬ 
ments  from  the  initial  configuration.  Instead,  only  the  positions  of  the  feet  are  stored  and  are  used 
as  the  basis  for  position  estimation. 

To  solve  the  dead  reckoning  problem,  it  is  assumed  that  at  any  given  time,  the  Ambler  can 
be  treated  as  a  rigid  body  (in  this  work,  the  effects  of  structural  distortion  are  ignored,  see  Section 
5  and  Section  6  for  further  discussion),  which  means  that  the  feet  do  not  move  unless  commanded 
to  do  so.  With  these  assumptions,  the  dead  reckoning  problem  becomes  one  of  finding  the  rigid 
body  transformation  (the  matrix  R  and  the  vector  T)  which  satisfies: 

3.1 

where,  is  the  position  of  foot  j  in  the  world  frame,  and  is  the  position  of  foot  j  in  the  body 
frame.  Both  P  and  P,  are  known  at  all  times  since  the  former  are  stored  and  the  latter  can  be 

wv  bj 

calculated  from  the  mechanism  kinematics.  Since  measured  data  is  imperfect  and  models  are  not 
exact,  a  solution  is  .sought  which  minimizes  the  squared  error,  t/(R,T),  where: 

</(R,T)  =  3.2 

J 

with 

e  =  P..;-RP..;-T  3.3 

where  vv  are  weights  w'liich  are  related  to  the  observations. 

1 

To  specify  the  position  and  orientation  of  a  rigid  body  in  some  frame,  the  position  of  three, 
non-colinear  points  fixed  in  the  rigid  body  must  be  known  in  that  frame.  If  fewer  than  three  points 
were  known,  the  problem  is  insoluble.  (If  only  one  point  were  known,  the  body  would  be  free  to 
rotate  about  that  point.  If  only  two  points  were  known,  the  body  would  be  free  to  rotate  about  the 
line  defined  by  the  two  points.)  If  more  than  three  points  are  specified,  the  problem  is  over-con¬ 
strained.  In  the  case  of  the  Ambler,  six  points,  the  positions  of  the  feet,  are  known,  thereby  over¬ 
constraining  the  problem.  One  approach  to  this  over-constrained  problem  would  be  to  discard  the 
extra  data,  but  ignoring  valid  information  does  not  seem  productive.  Another  approach  is  to  use  a 
method  which  allows  weighting  the  data  according  to  its  reliability.  The  weights  are  the  vv^  which 

appear  in  Equation  3.2  There  are  several  methods  for  doing  this  which  tu'e  discussed  in  Section  4. 
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In  summary': 

The  Ambler  dead  reckoning  problem  is  to  determine  the  position  and  ori¬ 
entation  of  the  Ambler  in  the  world  based  on  the  positions  of  the  feet  in  the 
world  frame.  The  solution  is  the  rigid  body  transformation  which  minimiz¬ 
es  the  squared  error  defined  by  Equation  3.2.  This  is  an  over-constrained 
problem. 

4  Approach 

The  implementation  of  dead  reckoning  on  the  Ambler  is  decomposed  into  three  components:  the 
elimination  from  consideration  of  slipped  feet,  the  solution  of  the  rigid  body  transformation  prob¬ 
lem  and  the  update  of  the  foot  positions.  The  first  step  is  used  to  remove  erroneous  data  points  so 
they  do  not  affect  the  accuracy  of  the  solution.  The  second  step  is  the  actual  position  determination. 
The  third  step  is  u.sed  to  update  the  positions  of  the  feet  based  on  the  newly  calculated  body  posi¬ 
tion. 

4.1  Checking  for  “slipped  feet” 

It  is  possible  that  a  foot  may  make  an  uncommanded  move  due  to  some  e.xternal  force;  this  would 
violate  our  assumptions.  To  achieve  the  be.st  position  estimate,  these  positions  should  be  eliminated 
so  they  do  not  corrupt  the  solution.  For  any  rigid  body,  the  distance  between  two  points  fixed  on 
that  rigid  body  is  a  constant.  Using  this  fact,  the  foot  positions  are  preprocessed  to  prune  any  sus¬ 
pect  ones.  Using  the  assumption  that  the  Ambler  is  a  rigid  body,  the  distance  between  each  pair  of 
feet  is  calculated  in  the  world  frame  and  the  body  frame,  and  then  compared.  In  predicate  form, 
this  can  be  expressed  as 


slip(i.j)  =  { 


1 

0 


Otherwise. 


4.1 


If  a  foot  slips,  the  rigid  body  assumption  is  violated,  and  the  difference  between  the  distance 
calculated  between  two  feet  in  the  world  frame  and  the  distance  calculated  between  two  feet  in  the 
body  frame  will  exceed  .some  allowed  value  A.  The  position  of  a  foot  which  is  found  to  have  slipped 
is  not  used  for  the  solution  of  the  rigid  body  transformation. 


4.2  Solution  of  rigid  body  transformation 

The  detemiination  of  a  rigid  body  transfoim  is  a  common  problem  in  computer  vision,  arising  fre¬ 
quently  in  techniques  such  as  motion  analysis  and  camera  calibration.  Three  different  techniques 
are  commonly  used  for  the  solution  of  this  problem.  The  first  method  ignores  the  fact  that  R  is  an 
orthonormal  matrix  and  treats  it  instead  as  a  matrix  of  nine  independent  unknowns.  Once  a  solution 
IS  obtained,  R  is  orthononnalized.  The  other  methods  treat  R  as  an  orthonormal  matrix  from  the 
start,  but  derive  the  result  by  different  repre.sentations  of  R.  The  second  method  leaves  the  problem 
in  the  fonn  of  vectors  and  matrices,  while  the  third  makes  use  of  quaternions. 

4.2.1  R  as  nine  independent  unknowns 

This  technique  is  conceptually  the  simplest,  but  probably  yields  the  worst  results.  The  fact  that  R 
is  a  nitation  matrix  is  ignored,  instead  it  is  treated  as  a  matrix  of  nine  independent  unknown  quan- 
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titles.  This  allows  rewriting  the  right-hand  side  of  Equation  3.1  as  a  matrix  of  con.stants  multiplied 
by  a  vector  of  12  unknowns  (9  from  R  and  3  from  T).  Since  each  foot  position  consists  of  three 
values  (the  Canesian  coordinates  in  the  world  system),  a  minimum  of  four  foot  positions  are  re¬ 
quired  to  find  a  solution  using  this  method.  A  solution  which  minimizes  the  squared  error  i.s  applied 
to  obtain  R  and  T,  [GelVd].  Once  an  R  matrix  is  obtained,  Gram-Schmidt  orthonormalization,  or 
equivalent,  [PFTW881,  is  applied  to  make  R  an  onhoriormal  matrix. 

This  method  seems  appealing  because  of  the  simplicity  of  the  solution.  However,  the  solu¬ 
tion  may  require  more  computer  time  than  the  other  methods  due  to  the  inversion  of  a  1 2x  1 2  matrix 
and  the  orthonormalization  procedure.  In  addition,  poor  results  are  expected  becau.se  there  are  not 
12  independent  unknowns,  but  rather  only  six. 

4.2.2  R  as  a  rotation  matrix 

Two  techniques  are  presented  which  find  the  solution  to  Equation  3.2.  The  first  represents  R  as  a 
matrix,  the  second  represents  R  as  a  quaternion.  Since  these  techniques  make  use  of  the  fact  that 
rotation  matrices  are  orthonormal,  only  three  foot  positions  are  required  for  the  solution  (see  page 
4). 


For  both  of  these  techniques,  auxiliary  equations  are  needed  in  addition  to  Equation  3.1  to 
ensure  the  orthogonality  of  R.  In  the  singular  value  decomposition  scheme,  these  are  expressed  as 
additional  constraint  equations  forcing  the  orthogonality  and  unit  norm  of  the  columns  of  the  ma¬ 
trix.  For  the  quaternion  approach,  this  condition  is  enforced  by  normalizing  the  resultant  quater¬ 
nions.  It  is  important  to  note,  that  in  both  of  these  cases,  as  well  as  the  previous  case,  the  solution 
is  obtained  without  iteration. 

The  Singular  Value  Decomposition  Technique 

The  derivations  for  this  method  are  found  in  |Mat89j  in  Appendix  B.l.  Given  a  set  of  j  measure¬ 
ments  with  associated  weights,  u'^,  the  best  estimate  for  R  and  T  to  minimize  Equation  3.2  is  given 

by: 
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E  =  USV^  4.6 

be  the  Miigular  value  decomposition  (S  VD)  of  E.  Then 

R  =  L'V'^'  4.7 

t  =  -  IP,  -RP,|  .  4.8 

vv  ‘ 

One  important  implementational  note  is  that  the  L'  and  V  matrices  returned  by  the  SVD  routine 
must  have  the  same  "handedness”,  that  is  they  must  both  be  right-handed  or  left-handed  (that  is, 
the  determinants  have  the  stime  sign),  otherwise,  the  result  of  Equation  i.7  will  be  incorrect. 


The  Eigenvalue  Technique 

This  solution  differs  from  the  singular  value  decomposition  approach  in  the  mathematics  only.  The 
underlying  principles  and  assumptions  are  the  same.  Faugeras  and  Heben  first  published  this  solu¬ 
tion  in  1FH86|.  First,  Equation  3.2  is  written  in  the  form: 

Cl  =  4.9 

j 

where  q  is  a  quaternion  representing  the  rigid  body  rotation,  t  is  a  quaternion  representing  the  rigid 
body  displacement,  and  v  is  a  quaternion  representing  the  data  points.  It  can  be  shown  that 


where  A  is  a  4.<4  matrix  and  *  i 

=  A^q 

s  the  quaternion  multiplication  operator.  Defining 

4.10 

< 

II 

4.11 

=  s-y  ■ 

J 

4.12 

the  solution  is  found  to  be 

4.13 

where  qmni  is  the  eigemector  as.sociated  with  the  minimum,  eigenvalue  of  the  matri.x  A  -  C^C/ZV, 
w  here  N  is  the  number  of  data  points.  The  rotation  matri.x  can  be  extracted  directly  from  qmm.  For 
furtlier  details,  refer  to  |Mor87|  and  |Ham691. 


Since  a  rigid  body  rotation  can  be  de.scribed  by  three  numbers,  storing  the  entire  R  matrix 
IS  supertluoiis.  Routines  are  used  to  uniquely  extract  three  numbers  from  a  rotation  matrix,  [CraSb], 
IKl.LS;^. 

4.3  Update  positions  of  slipped  feet 

After  the  position  of  the  body  has  been  calculated,  the  positions  of  the  teet  in  the  w'orld  are  calcu¬ 
lated  based  on  the  new  body  position  and  compared  to  the  stored  values.  Ideally,  there  should  be 
no  difference,  hut  since  the  algorithms  used  lire  based  on  minimizing  the  squared  error,  it  is  nt 
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expected  that  the  difference  will  be  identically  zero  for  any  foot.  To  minimize  the  accumulation  of 
error,  the  position  of  a  foot  is  updated  only  if  the  difference  exceeds  some  tolerance  value.  This  can 
be  done  since  the  primary  assumption  of  the  dead  reckoning  technique  is  that  the  feet  do  not  move 
unless  commanded  to  do  so. 

4.4  Determination  of  rotations 

.A  clinometer  measures  the  angle  of  the  gravity  vector  relative  to  itself.  To  understand  the  need  for 
clinometers  for  the  determination  of  the  tilt  angles,  the  following  thought  experiment  is  helpful. 
Imagine  the  Ambler  standing  in  a  normal  stance.  If  one  leg  were  to  fully  extend  vertically,  the  Am¬ 
bler  would  be  at  a  severe  angle,  with  only  three  feet  making  contact  with  the  ground.  This  violates 
the  assumption  that  feet  which  are  not  commanded  to  move,  do  not  move.  However,  in  this  case, 
the  dead  reckoning  would  erroneously  report  that  the  Ambler  had  placed  the  foot  into  a  deep  hole 
and  that  body  position  had  not  changed. 

To  solve  this  [iroblem,  clinometers  are  used  to  detect  the  body  tilt  angles.  After  the  dead 
reckoning  algorithm  has  computed  the  new  body  position,  the  clinometers  are  read,  and  the  values 
are  used  in  the  rotation  mtttrix.  Experiments  conducted  before  the  installation  of  the  clinometers 
showed  that  the  tilt  tingles  were  never  changed  by  the  dead  reckoning  algorithm.  The  effect  of  this 
was  that  the  dead  reckoning  reported  that  the  Ambler  was  walking  on  a  slope,  depending  on  the 
initial  value  of  the  slope  that  was  supplied  to  the  .system.  The  use  of  clinometers  dramatically  im¬ 
proves  the  accuracy  of  the  dead  reckoning.  Further  improvements  can  be  made  by  using  additional 
sensing  information.  This  will  be  discussed  in  more  detail  in  Section  6. 

5  Test  Results 

'fhis  section  first  describes  the  current  implementation,  then  presents  the  results  from  several  tests, 
'fhe  term  "slipped  foot”,  see  Section  4. 1 ,  is  actually  a  misnomer,  which  was  devised  before  the  Am¬ 
bler  had  been  constructed.  It  was  originally  believed  that  an  external  force  could  backdrive  a  leg, 
resulting  in  a  difference  between  the  commanded  leg  position  and  the  actual  leg  position.  Experi¬ 
ence  with  the  Ambler  has  shown  that  this  is  highly  unlikely,  however,  the  check  for  slipped  feet 
has  not  been  eliminated  becau.se  the  inclusion  of  an  erroneous  data  point  would  adversely  affect 
the  results  of  the  position  calculations. 

To  date,  the  only  approach  implemented  on  the  Ambler  for  the  solution  of  the  rigid  body 
transfonnation  problem  is  the  singular  value  decomposition  technique.  Several  tests  of  the  dead 
reckoning  accuracy  have  been  conducted.  To  test  the  real-world  accuracy  of  the  Ambler,  a  system 
was  devi.sed  which  measures  the  position  of  the  body  in  the  world  directly.  This  is  used  as  the 
ground-truth  against  which  the  accuracy  of  the  dead  reckoning  is  compared.  As  the  Ambler  moves 
along  a  path,  the  commanded  move,  the  dead  reckoned  position  and  the  directly  measured  position 
are  recorded  for  each  step. 

To  measure  the  ground  truth  position  of  the  Ambler,  retro-refiectors  were  mounted  on  the 
Ambler  in  several  locations.  The  positions  of  these  locations  in  the  body  frame  are  known  from 
direct  measurement.  To  determine  the  position  of  the  Ambler,  a  surveying  instrument  is  used  to 
locate  these  points  in  the  world  frame  By  using  the  same  technique  as  the  dead  reckoning  algo¬ 
rithm,  to  find  the  solution  of  a  rigid  body  transformation,  the  position  of  the  Ambler  is  calculated. 
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This  method  has  a  certain  degree  of  inaccuracy,  due  to  errors  in  measured  location  of  the  retro-re- 
llectors,  operator  inconsistency  in  taking  the  measurements,  the  use  of  a  least-squares  technique, 
etc.;  however,  each  measurement  is  independent  of  the  previous  measurement  and  the  error  sources 
are  independent,  so  there  will  be  no  accumulation  of  ground-truth  measurement  error. 

5.1  Test  Prior  to  Comprehensive  Calibration 

The  two  figures  below  are  the  results  of  a  dead  reckoning  test  in  which  the  Ambler  took  6  steps 
following  an  approximately  straight  trajectory.  Figure  5.4  shows  the  difference  between  the  com¬ 
manded  and  dead  reckoned  position.  The  error  is  on  the  order  of  several  millimeters  per  step.  Fig¬ 
ure  5.2  shows  the  difference  between  the  dead  reckoned  position  and  the  ground  truth  position. 
This  shows  a  cumuhitive  error  on  the  order  of  3.5  cm  per  step  (seven  percent  of  the  body  advance). 

As  seen  in  the  figures,  the  dead  reckoning  calculation  is  consistent  with  the  commanded 
body  moves.  This  is  becau.se  both  the  dead  reckoning  and  commanded  move  routines  use  the  same 
kinematic  routines,  which  are  based  on  a  set  of  nominal  leg  parameters.  These  leg  parameters  were 
derived  from  the  blue-prints  for  the  Ambler  and  do  not  accurately  represent  the  as-built  configura¬ 
tion  of  the  machine.  Kinematic  inaccuracies  are  a  large  contributor  to  the  oiiference  between  the 
dead  reckoned  position  and  the  ground  truth  position. 

It  is  important  to  note,  that  even  though  the  results  from  this  test  were  quite  poor,  the  seven 
percent  error  is  systematic,  not  random.  That  is,  the  dead  reckoned  position  always  fell  short  of  the 
actual  position.  This  indicated  that  a  bias  existed  in  the  system  that  had  not  been  properly  modelled. 

5.2  Kinematic  Improvements 

To  perform  the  basic  task  of  walking,  an  error  of  3.5  cm/step  is  too  large.  To  reduce  this  error,  some 
calibration  work  was  done  on  the  Ambler.  This  resulted  in  improvement  in  two  areas;  a  good  rep¬ 
resentation  of  the  kinematics  of  the  extensional  links  and  a  model  of  the  structural  deflection. 

As  noted  in  Section  5.1,  the  parameters  used  for  the  calculation  of  the  commanded  body 
moves  and  the  dead  reckoning  were  ba.sed  on  as-drawn  values.  As  expected,  the  as-built  mecha¬ 
nism  differs  from  the  as-drawn  mechanism,  and  a  method  is  needed  to  determine  the  actual  dimen¬ 
sions.  This  is  a  robot  calibration  problem  and  has  been  solved  previously,  for  example 
IMTR8S1.  The  basic  idea  of  this  calibration  scheme  is  that  each  of  the  Denavit-Flartenberg  param¬ 
eters,  1DH55I,  is  perturbed  slightly  from  its  nominal  position.  The  penurbed  values  can  be  solved 
for  by  accurately  measuring  the  end  point  of  the  robot  and  comparing  this  position  to  the  robot  con¬ 
troller’s  estimation  of  its  position  (based  on  the  nominal  kinematic  parameters). 

Since  the  largest  error  occurred  in  the  plane  of  motion,  only  the  inner  and  outer  links  were 
calibrated.  This  significantly  reduced  the  .scope  of  the  calibration  problem,  since  the  these  links 
fomi  a  planar  mechanism.  The  parameters  of  interest  are  the  outer  link  off-sets  from  the  shoulder 
joint  in  both  planar  dimensions,  see  Figure  5.3.  The  distance  from  the  foot  to  the  shoulder  Joint  was 
measured  directly  and  the  outer  link  extension  is  known  exactly  as  a  function  of  the  gearing  ratio. 
Using  a  least-squares  algorithm,  the  values  of  the  two  parameters  of  interest  were  updated  to  reflect 
the  as-built  confiszuration. 
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Figure  5.3.  Ambler  leg  detail 

The  structure  ot  the  Ambler  deflects  due  to  the  weight  of  its  body.  'I’his  deflection  causes 
two  phenomena:  a  point  on  the  body  is  lower  than  expected  (sag)  and  the  feet  move  apart  from  each 
other  (spread).  To  improve  the  accuracy  of  the  dead  reckoning,  sag  and  spread  were  measured  for 
a  variety  of  tread  widths.  Using  this  data,  a  routine  was  written  which  can  approximate  the  sag  and 
spread  as  a  function  of  the  configuration. 

5.3  Test  after  Calibration 

After  the  incorporation  of  the  kinematic  improvements  detailed  in  Section  5.2,  another  dead  reck¬ 
oning  test  similar  to  the  first  was  conducted.  Again,  as  in  the  first  test,  the  dead  reckoned  position 
and  the  commanded  move  were  consi.stent.  Figure  5.4  and  Figure  5.4  present  the  same  information 
as  Figure  5.4  and  Figure  5.2. 

After  these  improvements,  the  error  per  step  has  been  reduced  to  about  1.2  cm/body  ad¬ 
vance  (two  percent  of  body  advance).  As  in  the  previous  test,  the  dead  reckoned  position  always 
lags  the  actual  position.  There  are  two  possible  conclusions  that  can  be  drawn:  there  is  still  an  un¬ 
modelled  systematic  error  and/or  the  Ambler  slips  as  it  walks.  Instead  of  trying  to  determine  the 
.source  of  this  bias,  it  is  corrected  by  simply  adding  two  percent  of  the  body  advance  in  the  direction 
of  travel.  (See  Figure  5.6.) 


Figure  5.6.  Bia.s  correction 


The  inaccuracy  is  the  direction  perpendicular  to  the  line  of  travel,  the  world  Z  axis,  is  prob¬ 
ably  due  to  the  unmodelled  effects  of  the  foot  terrain  interaction.  This  inaccuracy  is  caused  by  the 
compression  of  the  soil.  The  Ambler  sinks  into  the  soil  with  each  step,  but  this  sinkage  is  not  mod¬ 
elled,  Examination  of  the  data  shows  that  the  Ambler  position  estimates  are  always  higher  than  the 
ground  truth  position.  The  error  in  angle  of  the  rotation  in  the  plane  shows  what  appears  to  be  a 
random  error,  on  the  order  of  0.1  degrees.  A  larger  number  of  points  would  have  to  be  studied  to 
determine  if  the  error  is  truly  random. 

The  current  results  are  sufficiently  accurate  to  be  u.sed  for  near-term  testing  of  the  Ambler. 
However,  as  the  mission  duration  increases,  greater  accuracy  will  be  required  from  the  navigation 
system.  This  will  be  achieved  by  combining  the  dead  reckoned  position  with  other  position  esti¬ 
mates.  To  do  this,  the  uncertainty  of  the  dead  reckoning  must  be  modelled.  The  technique  presented 
above  for  removing  the  bias  is  a  first  step  towards  this  model,  but  is  insufficient.  However,  if  the 
error  in  the  angle  of  rotation  in  the  plane  is  shown  to  be  a  random  error,  then  its  uncertainty  model 
would  be  based  on  the  magnitude  of  the  error. 

6  Future  Work 

There  are  several  areas  in  which  work  still  needs  to  be  completed.  The  first  is  to  implement  alter¬ 
native  techniques  for  the  solution  of  the  rigid  body  transformation  problem.  The  second  is  to  per- 
fomi  more  tests  of  the  dead  reckoning  to  determine  system  accuracy  and  to  help  determine  an  error 
model.  A  third  is  to  account  for  small  positional  penurbations  of  the  foot  positions  which  are  not 
currently  modelled.  A  fourth  is  to  continue  testing  the  system,  including  turns,  point  turns,  longer 
distances,  different  soils,  etc. 

The  implementation  of  the  other  techniques  is  already  in  progress.  Since  the  bulk  of  the 
dead  reckoning  code  is  in  place,  all  that  is  required  are  routines  which  perform  the  actual  calcula¬ 
tions;  the  rest  of  the  code  remains  unchanged.  Unfortunately,  testing  the  dead  reckoning  code  off¬ 
line  is  limited  to  simple  checks  of  a  static  model  to  determine  if  the  code  functions  properly.  The 
current  dead  reckoning  simulator  can  not  effectively  account  for  foot  slippage  on  the  soil,  terrain 
defomiation,  drive-train  over  shoot  and  backlash,  and  hence  lacks  rigorous  fidelity.  However,  ex¬ 
perience  indicates  that  if  the  routines  function  on  the  static  model,  they  will  function  on  the  Am¬ 
bler,  In  addition,  the  accuracy  of  and  computational  time  for  each  of  the  three  techniques  for  the 
solution  of  the  rigid  body  problem  will  be  compared.  Although,  computational  efficiency  is  not  of 
extreme  importance,  if  two  techniques  are  equally  accurate,  the  more  efficient  one  may  be  pre¬ 
ferred. 


These  techniques  will  be  tested  to  see  which  provides  the  greatest  accuracy  and  which  ex¬ 
ecutes  the  most  quickly.  Although  not  yet  implemented,  it  is  expected  that  the  quaternion  approach 
will  produce  results  of  the  same  order  of  accuracy  as  the  singular  value  decomposition  approach, 
hiir  u'iii  ,)r.  vr>  nmre  quickly  because  the  number  of  calculations  necessary  to  find  the  eigenvectors 
of  a  4x4  symmetric  matrix  is  fewer  than  the  number  of  calculations  to  find  the  singular  value  de¬ 
composition  of  a  matrix,  (  Actually,  only  the  eigenvector  associated  with  the  smallest  eigenvalue  is 
needed,  and  this  can  be  extracted  very  quickly.)  In  addition,  several  implementational  issues,  such 
as  matrix  handedness,  are  avoided. 


16 


Although  the  current  tests  have  provided  a  quantification  of  the  positioning  error,  funher 
tests  are  required  to  see  if  this  error  is  a  function  of  length  of  a  body  move  and  how  it  is  affected 
by  turns.  This  information  will  be  used  to  combine  the  dead  reckoned  position  with  the  position 
estimates  from  other  navigational  devices. 

As  stated  several  times,  a  primary  assumption  of  the  dead  reckoning  is  that  the  feet  do  not 
move  unless  commanded  to  do  so.  However,  this  is  not  the  case.  In  the  current  mode  of  operation, 
the  Ambler  walks  by  recovering  its  rear-most  foot,  placing  it  in  front  of  the  body,  loading  it  to  some 
pre-detemiined  force,  then  moving  the  body  forward.  For  dead  reckoning  purposes,  the  position  of 
the  foot  in  the  world  is  updated  after  the  foot  has  placed  down,  but  before  the  body  moves  forward. 
Since  most  terrains  are  compliant,  as  the  body  moves  forward,  a  greater  load  is  applied  to  the  front 
legs,  causing  them  to  sink  into  the  terrain.  Currently,  this  sinkage  is  not  accounted  for  and  may 
prove  to  be  a  source  of  inaccuracy.  These  effects  must  be  studied,  and  if  the  results  are  significant, 
they  should  be  incorporated  into  the  model.  This  study  should  also  provide  useful  information  that 
can  be  used  in  other  aspects  of  the  project  other  than  navigation,  e.g.,  determining  the  appropriate 
amount  of  force  to  apply  when  a  foot  is  set  down. 

7  Conclusion 

As  previously  stated.  Section  1,  dead  reckoning  alone  is  usually  not  sufficient  for  precision  navi¬ 
gation.  Other  sensors  are  needed  to  improve  the  overall  system  accuracy.  These  sensors  include 
gyroscopic  inertial  navigators,  magnetic  compasses,  global  positioning  system  (GPS),  terrain 
matching  using  vision,  celestial  navigation,  horizon  navigation,  etc.  To  maximize  the  accuracy  of 
the  system,  the  output  from  each  of  these  sensors  is  combined  in  an  appropriate  manner  to  maxi¬ 
mize  system  accuracy.  One  technique  for  combining  these  positions  and  uncertainties  is  Kalman 
filtering,  [Gel74|.  The  basic  concept  is  that  each  measurement  has  an  associated  uncertainty  and 
the  contribution  by  each  constituent  to  the  final  result  is  weighted  by  its  uncertainty. 

Testing  of  the  Ambler  has  shown  that  absolute  positioning  accuracy  is  on  the  order  of  sev¬ 
eral  millimeters.  In  Section  5,  the  best  dead  reckoning  results  presented  show  an  error  of  two  per¬ 
cent  of  the  body  advance.  The  question  must  be  raised  is  whether  more  time  should  be  spent  im¬ 
proving  the  accuracy  of  the  dead  reckoning,  perhaps  by  funher  mechanism  calibration?  The  au¬ 
thors  feel  that  this  is  not  necessary,  because  the  error  can  be  quantified  and  used  to  combine  the 
results  of  dead  reckoning  with  other  navigational  schemes. 

The  final  acceptance  tests  will  be  to  detemiine  the  accuracy  of  the  Ambler  as  it  walks  out¬ 
doors  over  large  distances,  elevation  changes  and  obstacles.  Even  though  the  floor  of  the  current 
test  area  has  been  sculpted  to  provide  varying  terrain  and  compliance,  the  range  is  quite  limited. 

The  dead  reckoning  system  implemented  thus  far  is  the  first  step  towards  the  goal  of  a  ro¬ 
bust.  autonomous  navigation  system.  A  key  development  in  the  work  to  date  was  the  recognition 
that  the  location  of  the  Ambler  can  be  determined  by  the  solution  of  the  rigid  body  transform  prob¬ 
lem.  which  permits  using  previously  developed  methodologies.  Initial  tests  of  the  system  have 
shown  that  the  system  works  well  and  have  indicated  those  areas  where  improvements  are  re¬ 
quired.  The  navigation  problem  takes  on  increased  importance  as  the  goals  for  the  Ambler  become 
more  ambitious.  The  work  presented  in  Section  4  is  only  the  beginning  of  the  solution  to  the  nav- 
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igation  problem,  a  problem  which  may  eventually  encompass  such  topics  as  soil  mechanics  and 

integration  of  additional  navigational  devices. 
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A  Discarded  Approaches 

The  first  approach  used  the  notion  that  the  shoulder  joints  for  each  of  the  legs,  on  either  stack,  lies 
along  a  line  in  space.  The  plan  was  to  pertbrm  inverse  kinematics  from  each  of  the  foot  positions 
to  locate  each  of  the  shoulders  in  space.  A  line  drawn  through  these  points  would  represent  the  two 
central  shafts  of  the  Ambler,  and  the  position  and  orientation  could  then  be  calculated.  This  ap¬ 
proach  was  rejected  because  it  appeared  to  require  an  iterative  technique  to  determine  the  orienta¬ 
tion  angles  and  because  it  seemed  that  it  would  give  poor  results  if  the  Ambler  was  not  perfectly 
vertical. 

The  next  approach  was  based  on  the  idea  that  three,  non-coincident,  overlapping  spheres 
intersect  at  exactly  two  points  in  space.  This  approach,  although  robust,  was  rejected  for  two  rea- 
.sons:  it  requires  an  iterative  .solution  and  there  was  no  way  to  extend  this  technique  to  solve  for  the 
rotation  angles. 

Once  it  was  realized  that  the  dead  reckoning  problem  is  the  determination  of  a  rigid  body 
transform,  the  utility  of  cenain  concepts  and  mathematical  approaches  became  apparent.  Particu¬ 
larly,  techniques  developed  for  camera  calibration  could  be  adapted  since  that  too  is  a  problem  of 
determining  a  rigid  body  transfomiation.  The,se  techniques  were  used  since  the  image  calibration 
problem  has  extensively  studied. 


